
#include <asm.h>

.global C_SYMBOL(SinWave_32u)

C_SYMBOL(ToneCosTable):

.byte    0
.byte    0
.byte    0
.byte 0x40
.byte 0x2D
.byte 0xC4
.byte 0xFE
.byte 0x3F
.byte 0xC1
.byte 0x10
.byte 0xFB
.byte 0x3F
.byte 0xE0
.byte 0xE5
.byte 0xF4
.byte 0x3F
.byte 0xC7
.byte 0x43
.byte 0xEC
.byte 0x3F
.byte 0xCB
.byte 0x2A
.byte 0xE1
.byte 0x3F
.byte 0x5A
.byte 0x9B
.byte 0xD3
.byte 0x3F
.byte 0xF9
.byte 0x95
.byte 0xC3
.byte 0x3F
.byte 0x48
.byte 0x1B
.byte 0xB1
.byte 0x3F
.byte 0xFB
.byte 0x2B
.byte 0x9C
.byte 0x3F
.byte 0xE2
.byte 0xC8
.byte 0x84
.byte 0x3F
.byte 0xE3
.byte 0xF2
.byte 0x6A
.byte 0x3F
.byte 0xFE
.byte 0xAA
.byte 0x4E
.byte 0x3F
.byte 0x4A
.byte 0xF2
.byte 0x2F
.byte 0x3F
.byte 0xF5
.byte 0xC9
.byte  0xE
.byte 0x3F
.byte 0x47
.byte 0x33
.byte 0xEB
.byte 0x3E
.byte 0xA0
.byte 0x2F
.byte 0xC5
.byte 0x3E
.byte 0x76
.byte 0xC0
.byte 0x9C
.byte 0x3E
.byte 0x59
.byte 0xE7
.byte 0x71
.byte 0x3E
.byte 0xEF
.byte 0xA5
.byte 0x44
.byte 0x3E
.byte 0xF7
.byte 0xFD
.byte 0x14
.byte 0x3E
.byte 0x48
.byte 0xF1
.byte 0xE2
.byte 0x3D
.byte 0xCF
.byte 0x81
.byte 0xAE
.byte 0x3D
.byte 0x92
.byte 0xB1
.byte 0x77
.byte 0x3D
.byte 0xAE
.byte 0x82
.byte 0x3E
.byte 0x3D
.byte 0x57
.byte 0xF7
.byte    2
.byte 0x3D
.byte 0xD9
.byte 0x11
.byte 0xC5
.byte 0x3C
.byte 0x96
.byte 0xD4
.byte 0x84
.byte 0x3C
.byte  0xA
.byte 0x42
.byte 0x42
.byte 0x3C
.byte 0xC4
.byte 0x5C
.byte 0xFD
.byte 0x3B
.byte 0x6E
.byte 0x27
.byte 0xB6
.byte 0x3B
.byte 0xC4
.byte 0xA4
.byte 0x6C
.byte 0x3B
.byte 0x9E
.byte 0xD7
.byte 0x20
.byte 0x3B
.byte 0xE8
.byte 0xC2
.byte 0xD2
.byte 0x3A
.byte 0xA3
.byte 0x69
.byte 0x82
.byte 0x3A
.byte 0xE8
.byte 0xCE
.byte 0x2F
.byte 0x3A
.byte 0xE8
.byte 0xF5
.byte 0xDA
.byte 0x39
.byte 0xE8
.byte 0xE1
.byte 0x83
.byte 0x39
.byte 0x42
.byte 0x96
.byte 0x2A
.byte 0x39
.byte 0x69
.byte 0x16
.byte 0xCF
.byte 0x38
.byte 0xE3
.byte 0x65
.byte 0x71
.byte 0x38
.byte 0x4D
.byte 0x88
.byte 0x11
.byte 0x38
.byte 0x59
.byte 0x81
.byte 0xAF
.byte 0x37
.byte 0xCE
.byte 0x54
.byte 0x4B
.byte 0x37
.byte 0x8A
.byte    6
.byte 0xE5
.byte 0x36
.byte 0x7E
.byte 0x9A
.byte 0x7C
.byte 0x36
.byte 0xB0
.byte 0x14
.byte 0x12
.byte 0x36
.byte 0x3C
.byte 0x79
.byte 0xA5
.byte 0x35
.byte 0x52
.byte 0xCC
.byte 0x36
.byte 0x35
.byte 0x36
.byte 0x12
.byte 0xC6
.byte 0x34
.byte 0x41
.byte 0x4F
.byte 0x53
.byte 0x34
.byte 0xDE
.byte 0x87
.byte 0xDE
.byte 0x33
.byte 0x90
.byte 0xC0
.byte 0x67
.byte 0x33
.byte 0xEA
.byte 0xFD
.byte 0xEE
.byte 0x32
.byte 0x93
.byte 0x44
.byte 0x74
.byte 0x32
.byte 0x48
.byte 0x99
.byte 0xF7
.byte 0x31
.byte 0xD6
.byte    0
.byte 0x79
.byte 0x31
.byte 0x1F
.byte 0x80
.byte 0xF8
.byte 0x30
.byte 0x18
.byte 0x1C
.byte 0x76
.byte 0x30
.byte 0xC7
.byte 0xD9
.byte 0xF1
.byte 0x2F
.byte 0x45
.byte 0xBE
.byte 0x6B
.byte 0x2F
.byte 0xBE
.byte 0xCE
.byte 0xE3
.byte 0x2E
.byte 0x70
.byte 0x10
.byte 0x5A
.byte 0x2E
.byte 0xAA
.byte 0x88
.byte 0xCE
.byte 0x2D
.byte 0xCD
.byte 0x3C
.byte 0x41
.byte 0x2D
.byte 0x4C
.byte 0x32
.byte 0xB2
.byte 0x2C
.byte 0xAA
.byte 0x6E
.byte 0x21
.byte 0x2C
.byte 0x7D
.byte 0xF7
.byte 0x8E
.byte 0x2B
.byte 0x69
.byte 0xD2
.byte 0xFA
.byte 0x2A
.byte 0x25
.byte    5
.byte 0x65
.byte 0x2A
.byte 0x78
.byte 0x95
.byte 0xCD
.byte 0x29
.byte 0x37
.byte 0x89
.byte 0x34
.byte 0x29
.byte 0x4A
.byte 0xE6
.byte 0x99
.byte 0x28
.byte 0xA7
.byte 0xB2
.byte 0xFD
.byte 0x27
.byte 0x52
.byte 0xF4
.byte 0x5F
.byte 0x27
.byte 0x62
.byte 0xB1
.byte 0xC0
.byte 0x26
.byte 0xFA
.byte 0xEF
.byte 0x1F
.byte 0x26
.byte 0x4C
.byte 0xB6
.byte 0x7D
.byte 0x25
.byte 0x9A
.byte  0xA
.byte 0xDA
.byte 0x24
.byte 0x32
.byte 0xF3
.byte 0x34
.byte 0x24
.byte 0x73
.byte 0x76
.byte 0x8E
.byte 0x23
.byte 0xC8
.byte 0x9A
.byte 0xE6
.byte 0x22
.byte 0xA8
.byte 0x66
.byte 0x3D
.byte 0x22
.byte 0x9B
.byte 0xE0
.byte 0x92
.byte 0x21
.byte 0x32
.byte  0xF
.byte 0xE7
.byte 0x20
.byte  0xF
.byte 0xF9
.byte 0x39
.byte 0x20
.byte 0xDC
.byte 0xA4
.byte 0x8B
.byte 0x1F
.byte 0x53
.byte 0x19
.byte 0xDC
.byte 0x1E
.byte 0x38
.byte 0x5D
.byte 0x2B
.byte 0x1E
.byte 0x5C
.byte 0x77
.byte 0x79
.byte 0x1D
.byte 0x99
.byte 0x6E
.byte 0xC6
.byte 0x1C
.byte 0xD8
.byte 0x49
.byte 0x12
.byte 0x1C
.byte  0xA
.byte 0x10
.byte 0x5D
.byte 0x1B
.byte 0x2B
.byte 0xC8
.byte 0xA6
.byte 0x1A
.byte 0x44
.byte 0x79
.byte 0xEF
.byte 0x19
.byte 0x64
.byte 0x2A
.byte 0x37
.byte 0x19
.byte 0xA7
.byte 0xE2
.byte 0x7D
.byte 0x18
.byte 0x31
.byte 0xA9
.byte 0xC3
.byte 0x17
.byte 0x31
.byte 0x85
.byte    8
.byte 0x17
.byte 0xDD
.byte 0x7D
.byte 0x4C
.byte 0x16
.byte 0x76
.byte 0x9A
.byte 0x8F
.byte 0x15
.byte 0x42
.byte 0xE2
.byte 0xD1
.byte 0x14
.byte 0x94
.byte 0x5C
.byte 0x13
.byte 0x14
.byte 0xC3
.byte 0x10
.byte 0x54
.byte 0x13
.byte 0x2F
.byte    6
.byte 0x94
.byte 0x12
.byte 0x3F
.byte 0x44
.byte 0xD3
.byte 0x11
.byte 0x63
.byte 0xD2
.byte 0x11
.byte 0x11
.byte  0xE
.byte 0xB8
.byte 0x4F
.byte 0x10
.byte 0xBE
.byte 0xFC
.byte 0x8C
.byte  0xF
.byte 0xF3
.byte 0xA7
.byte 0xC9
.byte  0xE
.byte 0x35
.byte 0xC1
.byte    5
.byte  0xE
.byte 0x13
.byte 0x50
.byte 0x41
.byte  0xD
.byte 0x1E
.byte 0x5C
.byte 0x7C
.byte  0xC
.byte 0xEF
.byte 0xEC
.byte 0xB6
.byte  0xB
.byte 0x22
.byte  0xA
.byte 0xF1
.byte  0xA
.byte 0x59
.byte 0xBB
.byte 0x2A
.byte  0xA
.byte 0x37
.byte    8
.byte 0x64
.byte    9
.byte 0x67
.byte 0xF8
.byte 0x9C
.byte    8
.byte 0x96
.byte 0x93
.byte 0xD5
.byte    7
.byte 0x72
.byte 0xE1
.byte  0xD
.byte    7
.byte 0xAF
.byte 0xE9
.byte 0x45
.byte    6
.byte    3
.byte 0xB4
.byte 0x7D
.byte    5
.byte 0x25
.byte 0x48
.byte 0xB5
.byte    4
.byte 0xCF
.byte 0xAD
.byte 0xEC
.byte    3
.byte 0xBE
.byte 0xEC
.byte 0x23
.byte    3
.byte 0xAF
.byte  0xC
.byte 0x5B
.byte    2
.byte 0x5F
.byte 0x15
.byte 0x92
.byte    1
.byte 0x90
.byte  0xE
.byte 0xC9
.byte    0
.byte    0
.byte    0
.byte    0
.byte    0
.byte    0
.byte    0
.byte    0
.byte    0

_SIN_SAMP_2PI_Q15:
.byte 0x3F
.byte 0x24
.byte    3
.byte    0

_SIN_INVPIQ32:
.byte 0xB7
.byte 0xC1
.byte 0x7C
.byte 0x51

_SinWave_32u:

arg_0=	0

    STMFD	SP!, {R4-R12,LR}
    MOV LR, R0
    LDR R0, [LR, #0x0]                  //pDst
    LDR R1, [LR, #0x4]                  //length
    LDRH R2, [LR, #0x8]                 //magnitude
    LDRH R3, [LR, #0xC]                 //frequency
    LDR	R4, [LR, #0x10]                 //phase
    LDR	R9, [LR, #0x14]                 //scale

    LDR	R5, =_SIN_INVPIQ32
    LDR	R6, [R5]
    SMULL	R7, R5,	R4, R6
    MOV	R3, R3,LSL#1
    LDR	R4, =_ToneCosTable

SinQ15_Direct_16s_Loop:

    LDR	LR, =0xFFFF
    AND	R5, R5,	LR
    MOV	R6, R5
    MOV	R7, R5
    MOV	LR, #0x10000
    MOV	R12, #0x8000
    CMP	R6, R12
    SUBGT	R6, LR,	R6
    MOV	LR, #0x4000
    CMP	R6, LR
    SUBGT	R6, R12, R6
    MOVGT	R8, #1
    MOVLE	R8, #0
    CMP	R7, R12
    SUBGT	R7, R7,	R12
    CMP	R7, LR
    MOVGT	LR, #0
    MOVLE	LR, #1
    MOV	R7, R6,LSR#7
    MOV	R7, R7,LSL#2
    LDR	R10, [R4,R7]
    ADD	R7, R7,	#4
    LDR	R11, [R4,R7]
    SUB	R7, R7,	#4
    AND	R6, R6,	#0x7F
    SUB	R11, R11, R10
    MUL	R12, R11, R6
    MOV	R12, R12,ASR#7
    ADD	R6, R10, R12
    RSB	R7, R7,	#0x200
    LDR	R10, [R4,R7]
    MOV	R10, R10,LSR#14
    MOV	R11, R10,LSR#2
    ADD	R10, R10, R11
    CMP	LR, #0
    ADDEQ	R6, R6,	R10
    SUBNE	R6, R6,	R10
    MOV	R10, #0x20000000
    MOV	R11, #0
    SMLAL	R10, R11, R6, R2
    MOV	R11, R11,LSL#2
    ORR	R12, R11, R10,LSR#30
    CMP	R8, #0
    RSBNE	R12, R12, #0
    MUL R6, R12, R9
    MOV R7, R9, LSL #15
    ADD R12, R6, R7
    STR	R12, [R0], #4
    ADD	R5, R5,	R3
    SUBS	R1, R1,	#1
    BGT	SinQ15_Direct_16s_Loop

    LDMFD	SP!, {R4-R12,PC}
